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Abstract 

Asymptotically stable linear time invariant systems are capable of tracking arbitrary reference signals with a bounded error 
proportional to the magnitude of the reference signal (and its derivatives). It is shown that a similar property holds for a general 
class of nonlinear dynamical systems which includes all robots. As in the linear case, the error bound may be made ^arbitrarily* 
small by increasing the magnitude of the feedback gains which stabilise the system. "" 

1 Introduction 

Tracking is the archetypal pursuit of the control theorist. Given a dynamical system, 

* = /(*.«). 

V =h(r) 

and a specified ‘reference signal", r(f), it is required to find a control, u‘(t) such that the forced system, i = /(x,u‘) “tracks" r 
in some sense — usually lims-oo y = r. Solutions to such problems generally involve pre-filtering the reference trajectory through 
a suitable “feedforward" algorithm, and then adding a compensating error driven “feedback* term to arrive at the input, u‘. If 
the reference signal is known k priori, then the feedforward algorithm may entail pure differentiation to “pre-compensate" for 
the lags introduced by the dynamical system itself. However, on-line differentiation of unknown and unpredictable signals has 
long been eschewed by control theorists as an unreliable technique for both theoretical as well as practical reasons. 

This paper considers the problem of tracking in the context of telerobotic manipulators. It is shown that a general class 
of highly nonlinear control systems which includes all robot models admits tracking algorithms based upon high gain linear 
state variable feedback. The choice of a pure feedback based algoiithm for tracking is surely not optimal in any sense of the 
word. However, the only other techniques which are known to guarantee tracking for this class of systems make use of feedback 
algorithms which attempt exact cancellation i 1 ,2,31, (or “nearly" exact cancellation, e.g. |4,5) ) of intrinsic nonlinear dynamical 
terms via feedback, and pure differentiation of the reference trajectory in the feedforward path. In robot applications admitting 
the use of a ‘high level" planner it is plausible that the entire future strategy might be made available at once to the “low 
level" controller in which case tracking scheme? requiring pure differentiation of the reference signal might be acceptable. In 
telerobotic applications the reference signal is, by definition, a priori unknown: it is generated as a record of the unpredicted 
arbitrary motion of a human agent of control. Schemes which require pure differentiation will probably not be useful in this 
context. 

In a sense, the result reported here simply represents another example of the similarity between general mechanical systems 
and second order linear systems. It is well known that asymptotically stable linear time invariant systems are capable of tracking 
arbitrary reference signals with a bounded error proportional to the magnitude of the reference signal (and its derivatives). For 
• fixed bound on this magnitude, the asymptotic tracking error may be made ‘arbitrarily" small by increasing the magnitude of 
the eigenvalues in the left half of the complex plane. In practice, this is accomplished by increasing the gain of linear feedback 
compensators. In this paper it is shown that the analogous property holds true for the more general class of nonlinear mechanical 
systems. 

As in the theory of linear servomechanisms, a practical obstacle to the systematic use of high gain feedback techniques in 
telerobotic applications is the inevitable presence of actuator torque limitations. Practical tracking strategies which address this 
problem while maintaining convergence guarantees are very much needed. This important consideration is entirely ignored here. 
The problem of characterizing the transient response of feedback compensated nonlinear mechanical systems is the topic of a 
paper currently in progress. 

‘This work is supported in part by the Nations! Science Foundation under grant no. DMC-SS05100 
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2 Preliminary Discussion 

2.1 Notation and Definitions 

If / : R* -* R“ hw continuous first partial derivatives, denote it • m x n jacobian matrix M Df . When we require only a subset 
of derivatives, e.g. when x 
we may write 


D.J £ Df 

If x : J _ R"»” is • smooth map taking matrix values then let 


, and we deeire the jacobian of / with respect to the variables x t g R">, as x, is held fixed, 

I 

0 J' 


p{A) £ sup sup |x T dx| 
i*J M-i 


and 


i /(A) = inf inf |x T dx|. 


If / is compact, or the entries of A are bounded then both »{A),p(A) are non-negative real numbers. For any constant matrix, 
n(A) is the square root of the eigenvalue of greatest magnitude, while p(A) is the square root of the eigenvalue of least magnitude 
of A t A, from which it follows that 

p(A) = sup||d(«)li 1/t '(A) = sup||d _l (q)||, 

e€J eat 


where || • || denotes the operator norm induced by the eulcidean norm of R". 

Given a set P, a smooth scalar valued map, « : P - R is said to be positive definite at a point p € P if v(p) = 0, and v > 0 
in some open neighborhood of p. Given a smooth (time invariant) vector field,/, on some phase, space, P, we shall say that, v, 
a positive definite map at ps g P, constitutes a Lyapunov function for J at p 4 if the time derivative along any motion of the 
vector field is non-positive, 

v = D,v f(p) < 0, 


in some neighborhood of p 4 , and that it constitutes a strict Lyapunov function for [ if the inequality is strict |6,7|. The domain 
of u with respect to p 4 is the largest neighborhood around p which is free of additional critical points and upon which the 
derivative is still non-positive. 

The existence of a strict Lyapunov function at a point is a sufficient condition for asymptotic stability of that equilibrium 
state. If a strict Lyapunov function has not been found, asymptotic stability may, nevertheless, be assured if a further condition 
on the possible limiting set holds. This is “LaSalle's Invariance Principle* (7). It is possible, as well, to draw conclusions about 
the tracking capability of a forced dynamical system in consequence of of the stability properties of the unforced vector field at 
a particular equilibrium state. However, this seems to require the use of a strict Lyapunov function. 

It has been known for quite some time that the total energy of a mechanical system may be interpreted as a Lyapunov 
function (8|. Unfortunately, this choice of Lyapunov function is never strict. The central contribution of this paper rests upon 
the construciion of a strict Lyapunov function for the general class of nonlinear mechanical systems described below, (1). The 
tracking results follow as a standard consequence. 


2.2 Dynamical Equations of Kinematic Chains 

The equations of motion of a kinematic chain have been extensively discussed in the robotics literature, and this paper will rely 
upon the standard rigid body model of an open chain with revolute joints. Thus, wc consider a robot to be a particular member 
of the class of mechanical systems, 

W[?l7 + B|(j, 9|7 + lt(?) = r (1) 


where the generalized positions take values in a configuration space, q € J, and AS is a positive definite invertible symmetric 
matrix for all q € J. As shown in the appendix, in the case of kinematic chains, AS, the “inertial* terms, B, the “coriolis and 
centrifugal* terms, and k, the gravitational disturbance vector, all vary in q by polynomials of transcendental functions. It 
follows that i'(Af) > 0 and p(.VS) < oo. 

This system may be rewritten in the form 

= <h 

= A/~'[fl<ft + k - r| ' ' 


where the generalized positions and velocities take values p — 


€ P = TJ in phase space — the tangent bundle over J. 
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While M, k an always bounded, the coriolli and centripetal force* are quadratic in the Telocity — i.e. B ie linear in 4 — 
and, therefore, may become unbounded. It is, however, bounded with reepect to 4, as the following technical reeult ehowa. 


Lemma 1 For any k € R", 
when 


is founded above. 
Proof: 


* T Bft * ?J^(*)ft 


M(k) 


k T D tl ,M 1 


k T D„.M 


4 <■! 


and, hence, 


Bft = (ft ® I ) 1 D,M* ft - 5 [(ft ® l) r D,M* ] T ft 
ft T B T * = q] [D,M* ] T (ft ® /)* - („ ® /) T D t M* k 


= 4j [■ 



’ ' * T B,„Af 1 

= ?! 

: 

k 



_ 1 




ft- 


Since M contain* transcendental functions in 4 , ail of its derivatives in q must be bounded. 

□ 

It follows that for some ii < 00 , 


Corollary 3 For all p € P, 


Proof: 


l|Af(A)|| < *11*11. 


ll \ " B|ft == 0. 


t\\\M - B]e, = e]\\M - M(ej)]rj 

= \q] j[D f M* ] T (ft ® /) - (ft ® /) T D,M* ] ft 
= 0 . 


f3t 


2.3 Stability Properties of “PD” Compensated Systems 

Suppose we are presented with the mechanical system (2), and a desired point. 


a 

Pt = 


€ P. 


Choose two positive definite matrices, K\,K\ > 0, and define the “PD" algorithm 

r = *( 4 ) - Ki[q t - 4 I - ^14- 

In terms of the translated “error coordinate system”for P, 


«(P) = 


9 - Id 

4 


the resulting closed loop system has the form 


0 I 

-M-'/f, - M- l (B + K ,) 


= 4ft ?i«- 


(4) 


(5) 


( 6 ) 
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Proposition 3 For all To >0, 

*> -!«(.)• * l-'l 1 *.*' J ( „]. 

to a Lyapunov /unction for tho closed loop system (6). 

Proof: It is clear that 0 is positive definite at the origin of the error system. Taking the time derivatives along ths 

solutions of the doeed loop system, (6), 

v = \e'\PA + A'P + P\e 

= - et [S J X| ]‘ + Tfo*I|}W-BK 

Noting that e t a gj, it follows from Corollary 2 , that the second term is identically sero. 


There follows the desirable result that proportional and derivative linear state feedback stabilises a mechanical system, after 
the gravitational disturbance torques have been removed. 

Theorem 1 ( [0,10,11] ) The origin of the closed loop error coordinate system (6) is asymptotically stable. 

Proof: The existence of a Lyapunov Function, v, assures stability. According to LaSalle’s invariance principle, the 

attracting set is the largest invariant set contained in {(*|, e>) 6 P : o s 0), which, evidently, is the origin, since the vector 
field is oriented away from {<i = 0} everywhere else on that hyperplane. 

□ 

Notice that the proof of attractivity requires an appeal to LaSalle’s invariance principle in consequence of the fact that ti 
is not a strict Lyapunov function. In order to obtain the desired extension to tracking problems it is necessary to construct 
one. Unfortunately, the constructions devised to date require the artificial limitation to decoupled PD feedback. Namely, in the 
sequel, it will be assumed that the gain matrices of (6) are specified as 

K x = u;*/; K, = 2 qul (7) 

given two positive real numbers, w, f. 


2.4 A Strict Lyapunov Function for Nonlinear Mechanical Systems 

The following technical lemma will be of use in the main result, below. 

Lemma 4 For M(q) as in (1) and any positive scalars, a, 3,1 6 R*, 


7 M(q) ‘-"M 


K = “ 


In particular, the matrix is positive definite when 
Proof: Since 

' al 

. P 1 

it will suffice to show that 


[ 0 iu(M) J ' 

when 

a~ii/(M) > 3* 

' al 31 | f al 01 

31 7 M(q) \ [31 7 v(M) j ~ ® '• 

u(K ® /) = o(K). 


This follows since all eigenvalues of K ® 1 are eigenvalues of K, according to Lemma 12 in the apper.au. The particular 
conclusion obtains by taking the determinant of K. 


Proposition 5 For all p 4 € P and > 0, given any bounded set, 3 C P, containing p 4 there exists a scalar 7o > 0 such that 

v(e) i l -e'P[q)c = V W,7o/ e 

2 2 wf/ 7 oA/(?) 

is a strict Lyapunov Function for the closed loop system, (6) on the domain 3, assuming the decoupled feedback gain matrices 
specified in (7). 
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Proof: 


lotting 


0 = sup||e||, 

■cl 


find tome -70 satisfying 


It l_ e&Ql 1 ,1 

I^Afj’WAf)* v(M) +1 f- 


According to Lemma 4 and the inequality involving the first entry of the inferior aet in (0), it follow* that P ia a positive 
definite matrix for all q € J, hence v, ia positive defnite at p*. 

Taking time derivatives along the solution* of system (6), we have 

v = Je T (PA + A T P + P]e, 


which may be expanded as 


v = -wfe 


T f w’Af- 1 u>M-' 1 

[ uM' 1 70/ J* 

-wf (70 - - uifejM-'Be, 


+7o«I(}iVf - B]«j. 

The term in the last line vanishes according to Corollary 2 . Moreover, the block matrix in the first line is positive definite 
according to the inequality (9) and the result of Lemma 4 since 


w’Af 1 

u/Af-‘ 

ltH 0 

' uPl u/I AH 0 

uM~ l 

7 o l 

” 0 Af-1 . 

u>I 7 0 M 0 Af"l 


Finally, according to Lemma 1 , the term in the middle may be rewritten a* 

wf|(7o - l)ejei + ejAf'Bej) = u»f*J((7 0 - 1)/ + XSf(Af' l «i)jei > 0, 
where k = and the result follows from the inequality involving the last entry of the set in (9). 

a 


3 Consequences for Tracking Unknown Reference Signals 

Now consider the decoupled “PD" compensated system forced by a continuously differentiable reference signal, 

T - k(q) - w’MO - «] - 2 wfy. (10) 

Assume that the reference trajectory is “unpredictable" — i.e. its first and second derivatives are unknown — but there is 
available an i priori bound on the maximum rate of change, 

llfcll < to- 

Notice that the forced closed loop system may be written in the same error coordinates as (5), above, 

e = A\q,q\e + d, (11) 

where d = [ j, is a “disturbance” input due to the unknown but non-zero reference derivative. 

Theorem 2 The closed loop ‘disturbed’ error system (11) has bounded trajectones which asymptotically approach the set 

{« 6 P ■ Ml < ~jf[W(Vf)’ + 1/w*} 

where 

K - ^ 1 

1 7o^(M)/w 

Proof: We have 

t> = }e T (PA + A’P + P\e + c*Pd , 

< - 2Aon(A#) N /(7o/ f )> + 1/ur’j . 

This is negative whenever e is outside the set indicated in the statement of the theorem. 
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Corollary A Tht asymptotic tracking hound mag he made arbitrarily email by increasing the magnitudes of the feedback gasses 
in (10) 

Proof: For a sufficiently large value of u it is possible to choose two real numbers K|,<ci € (0, 1) such that 

f = *1-70 y/v(M) I la = 

and the inequality (9) still holds. Using these definitions and the results of the theorem, the attracting region is bounded 
by the magnitude 

Note that 

v(K) = u + - i 0 i/(M)/u - yj(u - ioi/(M)/u) i + 4 

= U + Kiv(Af) - y/{i) - /Civ(Af)) 1 + 4, 

hence, 

du(K) t UI-KjUjM) _ „ 

^ y/(u-K l v(M))* +4 

and v(K) is bounded from below as u increases. Since x t may be made as small as desired without violating (9), the result 
follows. 


A The Stack Representation 

If A € R"”\ the “stack’ representation of A 6 R”* formed by stacking each column below the previous will be denoted A* 

( 12 |. 

If B € R' M , and A is as above then the kronukcr product of A and B is 

o» B ... a im B 

a ® B = a,lS "• a,mB eR B "■ , ^ 

- a» m B 

The kronecker product is not, in general, commutative. Mote that while the transpose “distributes’ over kronecker products, 

(A ® B) 1 = (A t 8 B T ), 

the stack operator, in general, does not. 

Lemma 7 If A 6 R"*™ then there exists a nonnngular linear transformation of R”"*, T, such that 

(A 7 )* = TA 3 

Proof: For p = nm, let 3 = {6,, ...,h,} denote the canonical basis of R F — i.e., 4,- is a column of p entries with a single 

* entry, 1, in position i, and the other ? - 1 entries set equal to zero. The transpose operator is a reordering of the canonical 
basis elements, hence may be represented by the elementary matrix, 

T' “ [b, , 6 n +l , bln+l ,..., 4j, 4„.,2, bln+h — i ...4„, b)„, 6sn, 4mnj . 


For n = m, if we define P+ = I + T, P- = I - T then both operators are projections onto the set of “skew-symmetric* , 
“symmetric" operators of R", repsectively, since P\ = P ± . Note that Ker P ± = Im P T . 

The kronecker product does “distribute’ over ordinary matrix multiplication in the appropriate fashion. 
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lamina • If A £ B € R'"*, C £ R""*, D £ R' ml Men 

‘(A • B)(C & D) m [AC ® BD), 
lemma 0 ([13] ) If B € R"”', A € R"“", andCe R'“» Man 

JABC) 1 -(C T »A)B*. 

Noting that for any column, a € R'* 1 , wa hava 

** “ ffl “ e * 

thara follows tha corollary 
Corollary 10 If B £ 71"“', < € R' Man 

Be - Be 1 - (e T « I)B* 

, - (|B«] T )* - (« T B T )" - (/ ® « T ) (fl T )* . 

Noting, moreover, that 

Ir {A} - (/*) T A , > 

thara follows tha additional result 
Corollary 11 // A € R"“",B € R'“* Man 

tr (aB t ) =» (a*) T D*. 

Proof: 

tr{AB T } = (^*)|(aR t )* 

= (/•) (B®/)A* 

= (a*) t (fl T 0 /)/* 

-MV 


Lemma 13 /or an# square array, A G R"“", »/ /„ is Ma identify on R" then Me spectrum o/ (X 0 /„) is contained in the 
spectrum of A. 

Proof: Suppose A is an eigenvalue of (A 0 /„). There must be some non-iero vector, * 6 R"* in the kernel of 

A(/„ 0 /„) -(A 9 1) Since i = X* € R"“", it follow, that 

0 « [A(/, 0 I m ) - (A 0 /)]* 

= [AX - XA T j* 

= [X(A/, — A T )J* . 

This implies that Im X T C Ker A f„ - A, and since the former subspace has dimension at least 1 (according to the 
assumption that X ^ 0), the latter must aa welt. Thus, A is an eigenvalue of A. 
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B General Robot Arm Dynamics 


Th« rigid body model of robot arm dynamic* may be moet quickly derived by appeal to the lagrangian formulation of Newton'* 
Equation*. If a icalar function, termed a lagrangian, A * k - v, i* defined aa the difference between total kinetic energy, a, and 
total potential energy, v, in a system, then the equation* of motion obtain from 

£d 4 A -D'A = r T , 

where r is a vector of external torque* and forces [13,14]. 

First consider the kinetic energy contributed by a small volume of mass in at position p in link Li,. 

it* = 

where °p< = °F, 'p is the matrix representation of the position p in the base frame of reference, °F, is the matrix representation at 
the frame of reference of link Li in the base frame, and { p is the matrix representation of the point in the link frame of reference, 
and, hence, 1 

Pi = F, *p , 

since the position in the body is independent of the generalised coordinates. The total kinetic energy contributed by this link 
may now be written 

= h, } [A ‘p] T A ‘pdm, 

= Se< } <r««{A *p [A *p^)dmi, 

= \ traee{Fi fc i pfp t dm i [fi] T } 

= J trace {F,T,F?}, 

(since the frame matrix is constant over the integration), where ?, is a symmetric matrix of dynamical parameter* for the link. 
Explicitly, if the link has mass, m, center of gravity (in the local link coordinate system) Pi, and inertia matrix, 7i, then 

■J5 A 7i Hipi 

* iZPi r Wi ■ 


Passing to the stack representation (refer to Appendix A) 

2k, = trace {FiJ>Fj} 

= [1/>@/) t f?] t f? 

= [AfAA* 

= |(D,/f 
= 4 T H4, 


where we have implicitly defined 

M.(l) = [D,F*] T P,D,F*-, A = A T ®/. 
It follows that the total kinetic energy of the entire chain is given as 


* = M(q) = £M,(9). 

The potential energy contributed by Sm , in Li is 


= zjF, ' pgim , 

where g is the acceleration of gravity, hence the potential energy contributed by the entire link is 

«i = 4 p i ’pgdm, = 4F,pig, 

and v = E."=i zjF,pig. ! 

To proceed with the computation, note that D , A = = q T M(q), hence, 

A =q T M(q) + q* M(q). 

1 We will omit the prior superscript, 0, when it is clew the the coordinate system of reference is the base 
^Assume that Xq ‘point* up* in a direction opposing the gravitational field. 
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Moreover, 

D,x « }4 t D,[M(M 

hence, if all term* from Lagrange’s equation involving the generalised velocity are collected, we may express them in the form 
4 t B t , where 

Finally, by defining k(q) = [D,v j T , Lagrange’s equation may be written in the form (1) 

M(q)q + B(q,i)q + k(q) = r. 

M, called the “inertia* matrix, may be shown to be positive definite over the entire workspace as well as bounded from above aince 
it contains only polynomials involving transcendental functions of q. B contains terms arising from “coriolis* and “centripetal* 
forces, hence is linear in q (these forces are quadratic in the generalised velocities), and bounded in q, since it involves only 
polynomials of transcendental functions in the generalised position. Finally, k arises from gravitational forces, is bounded, and 
may be observed to have much simpler structure (still polynomial in transcendental terms involving q) than the other expressions. 
An important study of the form of these terms wu conducted by Bejcsy [15]. 
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